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CONTROL  or  A OLIDING  PARACHUTE  SYSTEM  IN  A NON-UNIFORM  WIND 


I.  INTRODUCTION 

Th«  basic  philosophy  underlying  an  ^proach  to  the  control  of  a gliding 
parachute  systea  in  a non-uniform  wind  was  introduced  in  Section  I of  Pearson  [1] 
with  continuing  investigations  reported  in  [2]  and  [3].  This  philosophy  separates 
the  wind  and  initial  heading  estimation  problems  from  the  control  problem  in  mini- 
mising the  tersdnal  distance  of  the  parachute  from  a known  target  while  orienting 
the  parachute  tqwind  at  the  terminal  time.  Various  aspects  of  the  control  problem 
were  considered  in  [1-33  including  a cos^uter  sinulaticm  study  of  a Differential 
Dynamic  Programing  algorithm  for  solving  the  open-loop  optimal  control  problem 
[2],  a parameter  search  algorithm  and  analytical  investigation  for  the  optimal 
control  problem  [33»  and  a bang-off-bang  control  algorithm  based  geometric 
considerations  [3]. 

In  this  report  the  wind  estimation  and  initial  heading  estimation  problems 
are  examined  in  Section  II  with  particular  emphasis  given  to  a least  squares 
formulation.  Using  the  bang-off-bang  (open-loop)  control  law  described  in 
Section  VI  of  [33*  the  least  squarss  and  open-loop  control  algorithms  are  coabined 
to  yield  a closed-loop  control  law  which  has  been  simulated  wider  a variety  of 
non-uniform  wind  conditions.  The  results  of  this  simulation  are  included  in 
Section  III.  Other  types  of  estimation  schamos  have  been  considered  in  this  study 
and  are  discussed  in  Section  lit  ^ut  only  the  least  squares  algorithm  has  been  used 
in  these  initial  simulations  of  the  cloeed-loop  control  law  dus  to  the  relative 
•iaplloity  in  oomputing  the  least  squares  estimsts. 

The  aquations  of  notion  used  ttroughout  this  stu^t  [1-33.  are  the  kine- 
natie  relations  for  a noifom  daaoant  of  the  gliding  parachute  system  after  fail 

s 


# 


(1) 


daployMnt  haa  anauad: 

» a coa  0(t)  ♦ Wj^(t) 

^j(t)  « a aln  e(t)  ♦ 0 t t i t 

e(t)  ■ J tan  ♦(t)  . 

In  thaaa  ralatlona,  (pj^(t).  P2(t))  danota  tha  poaltion  coordlnatas  at  tiaa  t of 
tha  paraehvta  in  tha  horlaontal  plana  ralatlaa  to  tha  targat,  (Wj^(t)>  w^Ct)) 
danota  tha  aalocity  eo^Mnanta  of  tha  wind  aaetor  (asauned  to  lie  in  tha  horizontal 
plana  at  all  tinas),  6(t)  la  tha  inatantanaoua  haading  of  tha  parachute  velocity 
vaetor  ralatiaa  to  f iiad  coordlnataa,  and  4(t)  la  tha  parachute  bank  angle  relative 
to  tha  local  vertical.  Tha  aagnituda  of  the  parachute  velocity  vector  relative 
to  tha  wind  ia  denoted  hy  "a**  in  Eq.  (1),  a preauawd  known  conatant  of  aufficient 
aagnituda  to  facilitate  a wind  panatration  capability;  T la  the  tine  to  go  until 
touchdown  flE>OB  tha  initial  launch  tim  zero.  Altexviativaly,  the  third  equation 
in  (1)  can  be  axpraaaad  in  tama  of  tha  inatantanaoua  radlua  of  turn  of  the  para- 


(2) 

(3) 


chute,  iKt),  in  horlsontal  plana  via  tha  wall  known  kinanatic  relation 


a.a.  • 


tan  ♦ ■ — 

P* 


• rftT  • 

Lot  the  tlno  interval  0 < t f T be  divldad  into  M non-overlapping  aub- 
lataranla  t^  < t a t^^^,  i ■ 0,1... M-1,  with  t^  * 0 and  t^^  ■ T.  The  aatination 
prcblan  relative  to  tha  1-th  aiAintarval,  t^  ( t < eoaaiata  of  aatiaating 

tha  initial  heading,  OCt^),  and  tha  wind  profila  w(t)  over  t^  ( t < T,  baaed  on 
ebaarvad  data  ooUaetad  over  tha  pravioua  aubintarval  cr  intarvala.  Tha  obaarvad 
data  is  aaewd  to  be  cenpriaad  of  tha  paradnita  bank  angle  d(t),  tha  poaltion 
vaetor  p(t),  and  poasibly  (dapeading  en  tha  aatination  aehane)  tha  total  velocity 

A A 

vaetor  of  tha  parachute  P(t).  Oivan  tha  aatiaataa  O(t^)  and  w(t)  for  t^  a t g T, 
tha  eontrel  problan  relative  to  the  1-^  adbiatarval  oenaiata  of  ohooaing  tha 
angle  d(t),  or  aquivalantly  tha  turning  radlua  r<t),  en  t^  a t a tj^^^  audi 


I 


that  the  parachute  would  land  as  close  to  the  target  as  possible  in  an  upward  wind 


direction  at  the  terwinal  tine  if,  in  Act,  the  estinates  6(t^)  and  w(t)  were 
exact  and  #(t)  were  applied  for  all  t in  the  interval  t^  ( t < T.  The  estimates 

A A 

(e,w(*))  are  updated  over  the  next  subinterval  based  on  the  new  data  collected 

over  that  interval,  and  similarly  the  control  variable  ^(t)  is  re -computed  based 

on  the  new  estimates,  resulting  in  a step-by-step  control -estimation  sequence  which 

‘ constitutes  the  closed-loop  control  algorithm.  As  discussed  in  previous  repoz*ts, 

control  is  assumed  to  be  ef Acted  through  the  \we  of  an  on-board  servo  motor 

attached  to  the  support  lines  of  the  gliding  parachute  with  the  actual  relation 

between  f(t)  and  the  angular  position  of  the  servo  motor  to  be  determined  by  the 

particular  hardware  so  assembled.  All  computations  would  presumably  be  performed 

j by  a digital  computer  located  at  the  target  with  appropriate  telecommunications 

linking  the  ground  based  target  and  the  parachute.  However,  the  cosputations  are 

j sufficiently  simple  that  on-board  digital  computations  might  be  Aasible  if  such 

^ were  desired. 

II.  HIND  AND  INITIAL  HEADING  ESTIMATION 

Let  t^  N t s tj^  be  a typical  subinterval  over  which  data  is  observed  and 
it  is  desired  to  obtain  estimates  of  the  wind  profile  w(t)  and  initial  heading 
angle  O(t^)  « 0^  for  purposes  of  updating  the  control  algorithm  on  the  next  sub- 
interval. A general  approach  to  this  problem  would  model  w(t)  as  a stochastic 
process,  perhaps  with  an  underlying  Markov  process  representation,  and  proceed  to 
derive  the  partial  dlfArantlal  equations  Aom  which  the  ocnditional  means  of 
w(t)  and  0^  could  be  obtained  given  the  data.  However,  there  is  little  motivation 
to  fdraulate  this  All  blown  vsrslcn  of  the  estimation  problem,  at  least  at  this 
stags  of  the  investigation,  due  to  the  rather  extensive  computational  requirements 
anticipated  in  solving  the  partial  difArantial  aquations.  Therefore,  in  this 
section  the  siiplar  least  squares  estimation  of  w(t)  and  0^  will  be  formulated  and 
solved  in  closed  Atn.  Regarding  other  eatination  sohensa,  a minimum  variance 


•stiMt*  of  th«  wind  diroction  and  initial  paraehuta  heading  will  be  dlacussed 
for  the  special  case  in  which  the  magnitude  of  the  wind  vector  is  a known  constant. 


(a)  A Leaat  Squarea  Eatinate 

Let  the  wind  cosponents  in  (1)  be  modeled  by  the  polynosiials  of  pre- 
selected order  n: 

n 


»,(t)  » I o.  t^ 

»,(t)  « I B,  t^  • 

^ 1*0  ^ 


(4) 


In  practical  terms  n would  probably  be  chosen  as  either  n » 0 (a  constant  wind  of 

unknown  magnitude  and  direction),  or  n ■ 1 (a  variable  wind  with  linear  time 

varying  coaponants).  A laast  squares  estimate  of  the  parameters  (0  ,a  ..a  ,B  ..0  ) 

o o no  n 

rssults  }tpaa  minimizing  the  functional 


fl  n * 2 

J(6  ,0,0)  ■ Cfr,(t)  - a cos  (0^  ♦ U(t))  - y o.t^]  dt 

® Jt  ^ ® liO  ^ 

o 

♦ ct,(t)  - a sin  (0^  ♦ U(t))  - I 0.t^]  ^ 
it  * ® i.O  ^ 

o 

where  U(t)  is  defined  in  terms  of  the  bank  angle  #(t)  by 


(5) 


iC 


U(t)  ■ *•  I tan  0(t)  dt  . 

"o 

A naeessary  oondltion  for  the  ninimisation  of  (5)  is  the  adherence  of 
the  following  ralaticna: 


(6) 


i ■ 0,1.  .n  . 


Sine«  J is  quadratic  in  the  and  pazmetars,  the  second  and  third  sets  of 

equations  in  (6)  are  linear  in  (o,0)  and  can  be  solved  tmiquely  for  (a»0)  in 

terns  of  e and  the  data.  The  coefficient  matrix  for  the  linear  equations  in 
o 

(a,0)  is  the  Gramian  for  the  functions  {l,t..t’^}  on  t^  ( t < t^«  i.e.,  the 
sywsujtric  matrix  whose  ij-th  component  (i  = 0.,n  and  j » 0..n)  is  defined  by 

t. 


?1 

_ P 1 o 


(7) 


i+jtl 


0 < i J < n . 


Since  (l,t..t")  are  linearly  independent  for  any  > t^»  the  inverse  matrix 
of  6 exists  and  can  be  precomputed  and  stored  for  any  given  t^  < t < t^  interval. 
Letting  denote  the  ij>th  component  of  the  inverse  matrix«  6 the  soltitions 
for  and  0^^  become  (details  omitted): 


D 

Oi  ■ J cos  sin  e^)] 

n 

*i  * ^ HijCYj  - a(Cj  sin  + Sj  cos  0^)] 


0 < i < n 


the  scalars  (C^ »S^ *X ^ tY^ ) are  given  by 


- 


t^  sin  U(t)dt 


(8) 


fl  . 

I t^  cos  U(t)dt(  ®j  * I 

Xj  ■ J ^j(t)dt.  * I * 

o 

Si^bstitutlng  Eq.  (8)  into  the  first  of  the  relations  in  (6)  leads  to 
ttM  result 

9 


(9) 


(10) 


tr«) 


(U) 


Tj—  » 0 * A sin  6 - B cos  0^ 
00  o o 


where  A and  B are  defined  by 


■I 


A » I cos  U(t)  ♦ ^,(t)  sin  U(t)]dt 

’o 

n n 


- I I VVi^W 

i«0  J»0  J J ^ 


(12) 


and 


j(t)  cos  U(t)  - sin  U(t)]dt 


• I,  « 

o 

♦ I I H^.tX.Sj  - Y.Cj] 

i»0  j*0  J ^ 3 1 


(13) 


respectively.  Assuning  the  bank  angle  4(t)  is  not  identically  zero  on 

t < t ( t, , or  equivalently  that  U(t)  is  not  identically  zero,  (11)  can  be 
o X 

solved  for  0 « aodulo  2«,  taking  into  account  that  a minimal  value  is  desired, 
o 

i.e.,  taking  note  of  the  condition  that 

>^>o. 

This  solution  is  given  by 


* -IB 
0 ■ 2mv  t tan  x 
o A 


(14) 


where  n is  any  integsr.  Svbstituting  (14)  into  (8)  then  yields  the  final 
cloeed-fbni  solution  for  the  least  squsres  setimstes  of  the  quantities 

The  dbove  solution  is  oontingent  on  the  condition  that  0(t)  t 0 because 
A and  B eaeh  vanish  if  4(t)  • 0 on  t < t g t. . In  the  event  that  0(t)  ■ 0 for 

O X 

10 


■ -J 


all  t on  < t ( t. , eaimot  be  estinated  fvcm  the  given  data.  In  this  case 

0X0 

a prior  value  for  6^  should  be  assuwd,  based  on  data  collected  over  a previous 

A A 

subinterval  in  which  4(t)  $ 0,  and  (o,0)  can  be  obtained  from 


. n 

•j  • Hjj  <Xj  - CO.  e,) 

•l  • I "ll  •*"  «o> 


where  6^  is  the  a priori  value 


fat  9. 
o 


Finally*  it  should  be  noted  that  the  Integrals  involving  the  total 
velocity  vector  of  the  parachute*  ^(t)*  in  (10)*  (12)  and  (13)  can  be  equivalently 
expressed  in  terns  of  p(t)  using  integration  by  parts*  i.e.* 

t^ 

t^«  (16) 

^ t^S2(t)dt 

o 

fl 

I ^j(t)  cos  U(t)dt  « coa  U(tj^)  - Pj(t^) 

® fl 

♦ J I Pj(t)  tan  4(t)  sin  U(t)dt 

^ (17) 

I ^^(t)  sin  U(t)dt  « ‘in  U(tj^) 

'o  tj^ 

' a I Pi^'^  '■“  0(t)dt 

i ■ 1*2  . 

Thus*  a Icnowladfla  of  tiM  data  (p(t)*  #(t)>  on  t < t c t.  is  sufficient  to 

O X 

obtain  the  least  aqaaras  astiaata  af  tha  viad  asdal  (h)  and  initial  heading 

e(t  ). 
o 


I 


(b)  Statistical  Estiaatas 

Althou^  tha  ganaral  astination  problan  for  a stochastic  wind  w(t)  and 
randosi  initial  heading  is  probably  intractable  for  on-line  considerations, 

there  is  one  special  case  that  leads  to  a reasonably  straightfoiward  soltition 
in  coaputing  a ninissia  variance  estiaate.  This  approach  inwolees  nonlinear 
transforaations  on  the  data  to  achieve  an  underlying  linear  Maricov  process  in  a 
Banner  siailar  to  that  used  by  Villsky  and  Lo  [4]  for  a different  but  related 


estiaation  problea.  The  stochastic  differential  equations  for  this  case  are 


assused  as  follows: 

^j^(t)  * a cos  (e(t)  + Cj(t))  ♦ b cos  (a(t)  + 

^^(t)  « a sin  (e(t)  ♦ Cjtt))  b sin  (B(t)  ♦ CjCt)) 


(18) 


d8(t)  * u(t)dt  ♦ dnj^(t) 
dB(t)  * oa(t)dt  ♦ dn^Ct)  . 


(19) 


In  the  above,  the  aagnitude  of  the  wind  vector  is  assuMd  to  be  a known  constant 

parsawter  "b",  (C^(t),  are  independent  "white-noise"  Gaussian  processes, 

u(t)  is  a known  deteminlstic  forcing  fiaietlon  given  by 

u(t)  ■ J-  tan  d(t)  • (20) 

(Hj^(t),  ari  indepandant  Brawnlan  noiaa  prooaasas,  and  "c"  is  a given 

oonatant  oharaetarislng  tha  transitions  for  the  Harkov  process  w(t). 

Tha  nsassrsnant  data  is  aosanad  to  consist  of  tha  total  velocity  vector 

of  tha  paraehttta,  Mt)t  •>  « tha  bank  angle  d(t).  Equivalently,  the  data 

is  asswd  to  eonsist  of  tha  tripla  of  Iteetions  (u(t),  Sj^(t),  for 

tat.  where 
o 


12 


*,(t)  ■ » co«  (e  P OOS  (••  ♦ C-) 


*2(t)  * J ♦ Cj^)  ♦ p sin  («  + 


and  p > b/a  is  a known  constant.  Elininating  the  terns  Involving  (w  ■«■  C^)  in 
(21)  yields 

s^  + *2  ♦ 1 " 2|  |z|  I sin  (e  ♦ Cj^  + tan“^  ~)  = 

where  ||z||  » [z^  ^2^  * ^ssuning  principal  values  for  the  angles,  (22) 

is  seen  to  yield  two  values  for  6 t C.  depending  on  the  sign  of 
-1  *1 

cos  (e  C-  ♦ tan  -=•): 

^ *2 


2 2 2 

. -1  *1  . . -1  *1  ♦ *2  ♦ ^ 

-tan  — + sin  

*2  2||z|| 


e 


r 2 2 2-1 

1 *1  -1  *1  ♦ *2  ^ 

-i  _ sin  -i 1 if  ♦ < 

*2  2||z|| 


Mr  ♦ tan 


if  ♦ > 0 


where 


♦ « sgn  cos  (e  ♦ C,  ♦ tan'  ^)  . 

^ *2 


Sinilarly,  the  terns  involving  (0  t C^)  can  be  elininated  fron  (21) 
yielding  the  scalar  equation 


a*  ♦ Zj  ♦ p^  - 2|  |s|  I sin  (w  t ^2  tan"^  ^ 


Again,  two  values  for  (a  ♦ C9)  on  be  obtained  ft*on  (25)  depending  on  the  sign 

-1  *1 

of  coo  («  t t tan  ~),  (assusdlng  principal  values  for  all  angles): 

* *2 


I 


if  ♦ > 0 


« + Co  * 


-1  *1  -1 
-tan  ^ ♦ ain 

*2 


2 2 2 

♦ Xj  ♦ p''  - 1 


2 X 


-1  *1  -1 
ir  t tan sin 

^ *2 


r_2 
1 


2 

^2 


2 z 


(26) 


if  ♦ < 0 


where 


-1  *1 

♦ ■ agn  coa  («  t t tan  — ) . 

^ *2 


(27) 


The  aabiguity  in  the  expresaions  (23)  and  (26)  cannot  be  reaoleed  in 

any  siaple  way.  However,  considering  the  time  derivative  of 
-1  *1 

sin  (e  ♦ C,  ♦ tan  ~); 

A Xj 


at 


sin  (6  + C-  tan"^  ^)  ■ cos  (8  ♦ ?,  + tan"^  -i)  ^ (6  + C,  ♦ tan~^  -i) 

X z«  1 z.  dt  1 z. 


-1  *1 

■ u(t)  cos  (6  ♦ Ct  + tan  -=•)  . 

^ *2 


-1  *1, 


The  latter  approximation  holds  if  the  angular  rate  term  * tan~  ~) 

is  dominated  by  6(t)  ■ u(t).  Then  the  function  8 in  (24)  becomes 


8 * (sgn  u(t)}  sgn  -rz  xin(8  ♦ C,  ♦ tan”  ^)  . 

at  1 Zj 


(28) 


z 

But  sgn  (^  sin  (8  t t tan  ^ ~)}  can  be  ei^ressed  in  terms  of  z(t)  and  z(t) 
by  differentiating  (22)  and  assuming  ||z||  > 0: 

•gn  sin  (8  ♦ ♦ tan"^  jj))  « sgn  ((x^ij^  Z2i2)(x^  ♦ Zj  - 1 ♦ P*)).  (29) 

This  iaplias  that  tbm  valus  of  8 in  (28)  can  be  resolved  if  the  sign  of  the 
quantity  in  braekets  on  the  rl^t  side  of  (29)  can  be  determined  fbom  the  measure- 


llewever,  it  should  be  raitarated  that  this  result  depends  on  the  aasvap- 
tion  that  8(t)  • u(t)  dominates  the  angular  rate  ^8  * * tan”^  ~). 
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♦ r 


Th«  value  of  • in  (27)  can  be  related  to  the  value  of  # froa  the  follow- 

-1  *1 

inf  trigonoMtric  consideratione.  Let  X ■ tan  — eo  that 

*2 


coa  X * 


‘2 


sin  X ■ 


“1 

fil 


Than  the  following  identity  follows  from  (21): 

cos  X • S2  sin  X * cos  X cos(6  * C^^)  * p cos  X cos(m  t C2) 

- sin  X sin(6  t C^^)  - p sin  X sin(«  -t-  ^2^ 

« cosCX  ♦ • ♦ ♦ p oosCX  ♦ w ♦ Cj] 

■ 0 . (30) 


But  p is  positive  so  that  B ■ -1^,  which  resolves  the  asbiguity  in  (26)  once  # is 
detensined. 

Given  the  nonlinear  transforaations  on  the  data  so  that  the  right  hand 
sides  of  Eqs.  (23)  and  (26)  are  known  at  each  instant  of  tine  t,  the  second  pair 
of  equations  in  (19)  can  now  be  regarded  as  a vector  Markov  process  with  linear 


aeasureaents  as  sisaisi  tzed  by  the  following  natrix  equations: 


u dt  V d 


(31) 

(32) 


where  and  S2  denote  the  right  hand  sides  of  (23)  and  (26),  respectively. 

Equations  (31)  and  (32)  are  now  in  the  standard  fora  for  application  of 
the  Kalaan-Buey  filter  [5]  in  obtaining  a ainlnua  variance  estlnate  of  the  pair 
(e(t),  a(t))  conditioned  on  tiie  data  (Sj^(t),  S2(t)).  The  filter  for  this  estlnate 


is  given  by 


dx«AxdttBttdtt  K(t)[s  - nldt,  x(o)  ■ E(x^) 

o 


(33) 


A A A t 

where  x > (6,  «) ; A and  B are  the  coefficient  natricea  in  (31),  and  the  gain 
Matrix  K(t)  ia  coifjuted  off-line  according  to 


K(t)  = P(t)R^^ 

^ » AP  ♦ PA'  ♦ - PRJ^P  . R(o)  « 

where 

Rj^dt  ■ E(nn') 

and 


(34) 


Rj  « E(«’) 

are  preauaed  to  be  given  covariance  natricea  with  R^  positive  definite. 
Equation  (33)  ia  the  real-tine  realization  of  this  optimal  filter  given  that 
the  gain  natrix  K(t)  has  been  pre-conputed  off-line  by  the  integration  of  the 
Riccati  differential  equation  in  (34). 


III.  CLOSED  LOOP  CONTROL  ALGORITHM 

Given  eatinates  of  the  wind  vector,  (w^^(t),  Wj(t)),  over  < t < T,  and 
the  initial  heading  of  the  parachute  relative  to  wind,  B(t^)*  aa  determined  by 
the  laaat  aquaraa  fomulae  of  Section  Il-a  involving  the  data  obaerved  over  the 
previoua  aubinterval,  the  follcwing  tranefcmationa  to  normalized  coordinates 
sinpli^  the  kinanatic  equations  for  control  ooDsiderations : 

*i^'^  * TfLt  CPj(t)  ♦ w^(C)dO*  i ■ 

Xj(t)  ■ B(t)  . (35) 

RaMFitiag  Eq.  (1)  ia  tame  of  and  introducing  the  nomaliaed  tins  t. 


I 


1 

i 

I 


I 

1 

( 

i 


I 


and  the  nomallzed  control  variable  u. 


(T-t^)g 


tan  4 . 


the  kinematic  equationa  become  ' 

a coa  Xg(t) 

k^(t)  a sin  Xg(t)  0 # T < 1 
*j(t)  a u(t)  . 

The  desired  terminal  state  in  these  coordinates  is  given  by: 


(37) 


(38) 


Xj^(l)  a Xjd)  a 0,  Xg(l)  a /w(T)  ♦ V (39) 

where  /w(T)  denotes  the  estimated  wind  direction  at  the  texeiinal  time  T. 

The  optimal  control  problem  of  minimising  the  control  energy* 

I |u(T)|^dT«  while  driving  the  system  (38)  from  the  initial  state 
*o 


*i^®^  “ 7T-t  )a  ^**i^*o^  ■*”  *i<OdC].  i ■ li2 

X3(o)  a e(t^)  (40) 

to  the  terminal  state  (39)  has  been  Investigated  in  [2]  and  [3].  Assuming  the 
initial  coordinates  (x^(o),  x^(o))  lie  within  the  unit  circle,  this  is  a well 
posed  problem  with  moderately  demanding  computational  requirements  in  obtaining 
a solution.  The  Differential  Dynamic  Prograssiing  algorithm  for  cosputing  the 
optimal  control,  as  discussed  in  [2],  requires  a large  amount  of  cosputer  storage, 
but  tends  to  converge  in  a small  ntaber  iterations.  The  parameter  search  algorithm, 
discussed  in  [3]  and  furtbar  investigated  via  the  q>plication  of  the  Davison-Nong 
technique  C8],  requires  far  leas  msmoiy,  but  requires  many  more  iterations  to 
oofn^M*S0e 

Although  each  of  the  optimal  control  techniques  nsy  be  feasible  if  suffi- 
cient computer  hardware  is  available,  the  fkr  aiaplar  bang-o^-bang  algorithm  i 
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I 

i 


I 

I 

I 


1 


I 


d«serlb«d  in  Snction  VI  of  [33  was  utlllsod  for  tho  control  algorithn  in  closing 
ths  loop  using  ths  stop  by  stop  sstinstion-control  sequence  described  in  the 
Introduction.  Howeeer,  provision  in  this  algorithn  «ust  be  nade  for  the  possi- 
bility that  the  initial  conditions  in  (40)  nay  lie  outside  the  unit  circle  at 
the  start  of  any  particular  sub- Interval,  thereby  necesaitating  an  alternative 
control  strategy  (not  discussed  in  [23  or  [33)  for  this  situation. 

(a)  Control  Strategy  for  Initial  Conditions  Oxitside  the  Unit  Circle 
The  following  control  strategy  was  adc^ed  for  the  case  in  which 


(Xj^(o),  X2(o))  lie  outside  the  unit  circle.  Let  u(t)  be  constrained  to  be 
either  one  of  the  two  foms: 


or 


for  0 < T < t 
0 for  tj^  < T < 1 


to  for  0 < t < t, 

1 '■ 
- for  tj^  < T < 1 


(41) 


(42) 


where  the  norendisad  tuniiag  radius,  y,  and  the  switching  tins  t^  are  to  be 
detendned  hf  nlninialng  ^ fwetlen 

J(tj)  ■ [xJ(D  ♦ x^(l)3  (43) 

subject  to  the  end-point  constraint 

Xj(l)  ■ A(T)  ♦ * . (44) 

Using  tha  control  u^  In  (41),  the  aquations  of  notion  (38)  can  be  inte- 
grated yielding  an  explicit  expresaion  for  J(tj^).  Tha  tersdnal  constraint  (44) 
iaplias  tho  following  relation  betwsan  y and  tj^: 


1 


Using  this  eonstrsint  and  ths  nsoassaxy  condition  for  a ninimun,  * 0,  the 

see  ^ 

following  values  for  t^  and  J « J(tj^)  are  obtained: 


* 1 ( , 1 
<1  = j U ♦ Xj^(o)  cos  V ♦ Xj(o)  sin  v ♦ - Cxj^(o)  sin  v 

3 

- Xj(o)  cos  V - Xj(o)  sin  Xg(o)  x^(o)  cos  Xg(o)  + sin  (v-Xg(o))]| 

cos  w - x^(o)  sin  V + [Xj^(o)  cos  x^(o) 

3 

<i2 

x^Co)  sin  Xg(o)  cos  (v-Xg(o))  - 1 - Xj^(o)  cos  v - x^(o)  sin  v]| 
wher«  d and  v az«  defined 


(46) 


(47) 


V a /w(T)  ♦ * 


d a 


Cv  - x-(o)  - sin  (w-x-(o))l  ♦ 4 sin^(' 


'>-x-(o) 


-) 


[v  - Xg(o)] 


(40) 


(49) 


With  the  abovs  value  for  t. , it  can  be  shown  that  > 0 so  that  t.  is  a 

‘**1 

■iniaal  point.  This  laplles  that  u^^  in  (41)  will  be  the  proper  control  to  apply 
(within  the  present  context)  provided,  in  addition,  that  0 < t*  s 1 and  v ft  x^(o). 

In  a slnllar  nanner,  the  differential  equations  can  be  integrated  using 
the  control  U2  in  (42)  resulting  in  an  eiq>licit  relation  for  J(tj^).  Again,  the 
teminal  oooetraint  (44)  Inplles  the  following  constraint  between  the  radius  of 


turn  Y and  t^  (cf.  (45)): 


1 - t. 


Y ■ 


/u(T)  ♦ * - 


(50) 


The  ■inialsing  value  of  t^  and  ocCTsapcnding  alniaal  value  of  J in  this  ease  is 
fe«d  to  be 
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0 


and 


* i |2  - 2 CO.  (v-XjCo)) 

tvW — 


♦ •in  V - Xj(o)  CO.  V 

3 


+ Xj(o)  CO.  Xg(o)  - Xj^(o)  .in  Xg(o)  - .in  (v-Xg(o))] 


- Xj^(o)  CO.  Xg(o)  - XjCo)  sin  Xg(o) 


} 


(51) 


Jj  “ J *3^®^  “ *2^®^  ®®*  *3^®^  * v-'x^(o)  ^’‘1^®^  ®®*  '' 

♦ x^Co)  sin  V - x^(o)  CO.  x^(o)  - x^(o)  .in  x^(o)  - 1 + cos(v-Xg(o))]| 


A.  in  the  previou.  ce,  U2  i.  feasible  only  if  t*  in  (51)  satisfies 

* 

0 s t^  « 1.  In  practice,  both  caMS  auat  be  considered  for  any  particular  set 
of  Initial  values  (x^(o),  .2(0))  lying  outside  the  unit  circle  with  the  choice, 
u^  or  u^,  based  on  feasibility.  It  could  be  that  neither  case  is  feasible  for 
certain  initial  data  in  which  caM  the  value  of  J can  be  coaputed  for  full  on,  or 
full  off,  control  during  0 ( t < 1,  and  that  control  selected  which  achieves  the 
saaller  value  for  J,  consistent  with  the  end  point  heading  constraint  (44). 

These  details  of  the  control  strategy  have  been  progranaied  into  the  Fortran  listing 
supplied  in  the  Appendix. 

(b)  Siaulaticn  Results  of  the  Closed  Loop  Controller 
Siaulation  studies  wore  oarriad  out  for  the  systea  (1)  using  a variety 
of  initial  conditions  (p^(o),  Pjto)#  *(o))  and  wind  profiles  (w^(t),  W2(t)) 
over  the  total  tins  interval  0 f t $ 307.5  see.  The  speed  of  the  parachute 
relative  to  wind  was  fixsd  at  a ■ 30  ft/see.  Five  subintervals  were  used  for 
the  step-by-step  eatination-ccntrel  ssqnsnes  with  the  lengths  of  these  sub- 
intervals defined  by: 
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tg  » 157.5 


• 7.5. 
tg  « 82.5,  « 232.5 

T = 307.5  . 

A snail  control  effort  of  nagnitude  0.01  was  exerted  over  the  first  subinterval 
in  order  to  avoid  the  degeneracy  discussed  at  the  end  of  Section  Il-a  in 
estimating  the  parachute  heading  e^. 

All  integrations  were  perfomed  using  a fourth  order  Runge-Kutta  sub- 
routine from  the  IBM  Scientific  Subroutine  Package.  A complete  Fortran  listing 
of  the  coeg>uter  program  is  given  in  the  Appendix.  The  differential  equations  for 
the  parachute,  the  generation  of  the  wind  vector,  as  well  as  all  the  relevant 
integrals  needed  for  the  least  squares  estimation  are  integrated  in  the  subroutine 

4 

labeled  CPLANT.  A linear  time  varying  wind  model  was  used  in  the  wind  estimation 
subroutine  (Eq.  (4)  with  n * 1): 

w^(t)  « o^  + e^t 

rne  actual  winds  used  in  the  stu^  are  given  in  Table  1.  The  analytical 
expressions  for  both  polar  and  rectangular  coordinates  of  the  wind  vector  are 
indicated.  A step-type  disturi>anoe  was  introduced  for  some  of  the  runs  as  indi- 
cated by  the  Aw^  colusns  in  Table  1.  These  disturbances  (where  indicated)  were 
ia^oeed  at  the  end  of  each  subinterval  according  to  the  rule: 

w^Cnew)  ■ w^(old)  v Aw^.  i ■ 1,2  . 

The  paraehute  trajectories  wider  eloeed  loop  control  are  shown  in 
Figs.  1-11  with  corresponding  plots  for  the  wind  profile  and  the  parachute  bank 
angle.  Two  different  trajectories  are  shown  on  each  Figure  corresponding  to  the 
two  different  sets  of  initial  conditions  indicated.  The  terminal  error, 

||p(T)||,  is  the  Euclidean  distance  in  feet,  while  A8(T)  denotes  the  error  in  the 
desired  pameh^e  heading  at  the  terminal  time.  These  trajectories  and  data 
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indicate  that  good  ter«inal  accuracy  can  be  obtained  for  smooth  variable  winds, 
with  some  deterioriation  in  accuracy  for  abruptly  shifting  winds.  The  bank  angles 
for  the  most  part  are  quite  reasonable,  although  there  were  brief  moments  where 
bank  angles  in  excess  of  30®  %iere  called  for  by  the  control  algorithm.  There  was 
no  attempt  to  determine  the  best  sizing  of  subintervals,  nor  to  experiment  with 
variations  in  the  estimation  scheme.  Such  experimentation  is  necessary  if  a 
practical  implementation  of  this  approach  is  undeirtaken. 

IV.  CONCLUSIONS 

Separating  the  wind  and  initial  heading  estimation  problems  from  the 
control  problem  to  obtain  a step-by-step  estimation  and  control  sequence  may  be 
a feasible  approach  to  the  gliding  parachute  control  problem  in  a nonuniform 
wind.  It  will  be  difficult  to  make  a more  definitive  statement  until  additional 
simulations  and  experimentations  are  carried  out.  Even  within  the  scope  of  the 
relatively  sisple  least  squares  estimation  scheme  used  in  this  study,  additional 
e]q>erimsntatlon  is  needed  to  determine  the  nud>er  and  sizing  of  subintarvals 
t^  < t $ ^*fber  or  not  to  combine  wind  estimates  over  adjacent  subinter- 

vals by  averagiBg  the  estimates  over  several  subintervals,  and  what  form  of  wind 
model  to  use  in  the  estimation  schema.  The  control  aspect  of  the  problem  is 
fairly  straightforward  from  a computational  viewpoint,  but  actuator  dynamics  have 
been  coapletely  neglected  as  indicated  by  the  instantaneous  step  changes  allowed 
in  the  pamehute  hank  angle.  Nora  sophisticated  estimation  and  control  algorithms 
might  offer  better  performance,  but  at  the  aiqMnse  of  more  complex  computations. 
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APPENDIX 


FORTRAN  PI 


THb  BKOmN  bicentennial  COMPUTER  CENTER 


THE  PURPOSE  IS  TO  ESTIMATE  AND  CONTROL  A PARACHUTE  GLIDING  SYSTEM  VlAOOOlO 
VIA  A least  square  ESTIMATION  SCHEME  (ESTM)  IN  ADOITION  TO  A BANG-V IA00020 
BANG  CONTROL  SCHEME  (PREO).  VIA30030 

A:PARACHUTE  SPEEO;CW3COEFF.  MATRIX  IN  OYNAMIC  WIND  MODEL  VIA00040 

OTES:  EST.  INTERVAL  LENGTH  ; OTIN:  INTEGRATION  INTERVAL  LENGTH  VIAU0050 
ERB0:ERRUR  BOUND  IN  RJNGE-KUTTA  ROUTINE  :EX:  EST  .PARACHUTE  HEAOI NGVI A00060 
EA:  EST.X-COMPONENT  WIND  COEFF.  ; EB:  EST.  Y-COMPONENT  WIND  COEFF.V I A00070 

IM:  no.  OF  INTEGRATION  INTERVAL  : IN:  NO.  OF  EST.  INTERVAL  VIA00080 

IP:  EXECUTION  CONTROL. IF  IP«l,STOP  EXECUTION  BECAUSE  THE  GEOME TRIG VI A00090 
APPROACH  FAILS.  : NC:  EST.  LOOP  COUNT  ;TI:  INITIAL  TINE  VIAOOIDO 

TF:  FINAL  TIME  ; TB:  STORED  SWITCH  TINE  VECTOR  ; XIN:INITIAL  STATEV I AOOl 10 
XF:  final  state  VECTORtANO  INTEGRATED  VECTOR  ; UM:  BANG-OFF  CONTROLVIA00120 

WD:  EST.  TERMINAL  WIND  ANGLE  ; PI: 180  DEGREE  IN  RADIANS  VIA00130 

CONV:CONVERSION  FACTOR  FROM  RADIAN  TO  DEGREE  VIAOOIAO 

FDS:  ESTIMATION  INTERVAL  ; FOI:  INTEGRATION  STEP  SIZE  VIAOOISO 

OG:  DEGENERATE  BOUND  XTF:  INTERMEDIATE  INITIAL  TIME  VIAD0160 

dev:  terminal  DEVIATION  FROM  WIND  OPPOSITE  VIA00170 

TC:  INITIAL  COUNT  TIME  : TGO:FLIGHT  TIME  IN  SECOND  V1A00180 

RK:  fraction  of  prediction  interval  : ISK'.SKIP  CONSTANT  EST. IF  ISKVIA00190 
• 1 VIA00200 

IMPLICIT  REAL*8(  A-H.O-Z)  VIA00210 

DIMENSION  XINI3)  tXFl(22)  >T  B(  2 ).  Cw  (2*  2 I . W IN  (2  ) . EA(  2 ) t EB(  2 I * TE  XI  3)  VIA00220 

COMMON  DTEStOTIN.ERBD.  T I .TF ,NC i INf I H VIA00230 

COMMON/ FI/ A.UM.T  B. CW . W IN . UP  » OG. TEX . P I .CONV  V I A00240 

COMMON/OUT/ TPR.THI , THETA . ENR« ALP tORBE  VIA00250 

COMMON /PR/ WO. IP  VIA00260 

COMMON/EX/TFIN.RK. ISK  VIA00270 

WRITEI6.32I  VIA00280 

FORMATIIH  .'DISTURBANCE.  NO.  OF  ORUPS'I  VIA00290 

READ! 5.29)DRBE.N0P  VIA00300 

DO  30  L0>1.N0P  VIA00310 

WRITE(6.28)  VIA00320 

FORMATIIH  .'FRACTION  OF  PREO.' .'  SKI P CONTROL* ) VIA00330 

KEA0tS.29)RK. ISK  VIA00340 


TO  GO') 


NO.  . INITIAL 
>1 .3) .ERBO 


FORMATION. 8 .12) 

WRITEI6.2A) 

FORMATIIH  .'INITIAL  COUNT  TIME  . TIME  TO  GO*) 

REA0(».5)TC.TG0 

WR1TEI6.11) 

FORMATIIH  .'EST.NO..INTG.  NO.  . INITIAL  STATES.  E 
READ  IS. 2) IN.IM. IXINII) .1-1 .3) .ERBO 
FORMAT12I4.4014.8) 

WR1TE16.9) 

FORMATIIH  .'PARACHUTE  SPEED  W.R.T.  A1R*»*»  INITIA 

REAOIS.SIA.UM 

WRITEI6.10) 

FORMATIIH  •*  INITIAL  COND.  OF  WIND  COMPONENTS') 
REA0I5.5)IWINII).I-1.2) 

FORMAT  I20U.8) 

WRI TEI6  .6) 

FORMATIIH  .'COEFF.  MATRIX  IN  OYNAMIC  MIND  MODEL') 
DO  7 1*1.2 

REA0I5.S)ICWII.J).J-1.2) 

TFIN»TfT(iO 

PI-OARCOSI-l.OO) 


STATES.  ERROR  BOUND') 


INITIAL  CONTROL') 


VIA00210 

VIA00220 

VIAD0230 

VIA00240 

VIA002S0 

V IA00260 
VIA00270 
VIA00280 
VIA00290 
VIA00300 
VIA00310 

VI  A00320 
VIA00330 
VIA00340 
VIA00350 
VI  ADO 360 
VIA00370 
VIA00380 
VIA00390 
VI  ADDA  DO 
VIAOOAIO 
VIA00A20 
VI A00430 
VIA00A40 
V1A00450 
VIA00460 
VI  A00470 
VIA004B0 
VIA0U490 
VI A00500 
VIAOOSIO 
VIA00520 
VIA00S30 
VIAOOS40 
VIAOOSSO 


I 


FILE:  MAIN 


FORTRAN  PI 


THE  bRUWN  BICENTENNIAL  COMPUTER  CENTER 


C0NV-I.8D2/PI 

VIA00560 

F0S«TG0/0FL0AT(1N) 

VIA00570 

FOI-FOS/OFLOATIIM) 

VIA0U580 

0TES»0.100*F0S 

V1A00590 

0T1N*0.1U0*F0I 

VIA00600 

IP-0 

VI A0061U 

c 

V1A00620 

c 

INITIALIZE  FINAL  STATE,  INTG. 

VECTOR, 

EST.  VECTOR 

VIA00630 

C 

VI A00640 

00  12  1-1,22 

VIA0U650 

li 

XFII  n-0.00 

VIA00660 

EX-0.00 

VIA00670 

00  13  1-1,2 

VIA00680 

EAI I I-O.OO 

VIA00690 

13 

EB(I)-0.00 

V1A00700 

NC-0 

VIAJ0710 

T I-O.OO 

VI A00720 

TF-TI>OTES 

VIA00730 

TBI21-T1 

VIA00740 

STF-TC 

VIAU0750 

T8( ll-TF 

VIA00760 

c 

VIA00770 

c 

COMPUTE  STATE  AND  INTEGRATEO 

VECTORS 

VI A00780 

c 

V IA00790 

1 

CALL  PLANTIXIN.XFl) 

VI  AGO 800 

IFINC.EQ. INIGO  TO  22 

VI  A00810 

0G-0TIN*UM*»2«.  10-05 

V IA00820 

c 

VIA0083Q 

c 

ESTIMATE  HEADING  AND  WIND 

COEFF. 

VIA00840 

c 

VIA00850 

CALL  ESTM(XIN,XF1,EX,EA, EBI 

VIA00860 

c 

VIA00870 

c 

COMPUTE  BANG-BANG  CONTROL 

ACCORDING 

TO  MODEL  EQ. LEST. STATES. 

VIA00880 

c 

VIA00890 

CALL  PRE0(XIN,EX,EA,E8 

,STF  ,TlM,T2M.URi 

VIA00900 

c 

VIA0U910 

c 

UPDATE  INITIAL  CONO., START 

NEXT  ESTIMATICN  LOOP 

VIA  00920 

c 

VIA00930 

NC-KC^l 

VIAU0940 

IFINC.EO.IIGO  TO  20 

VIA00950 

TI-TUOTES 

VIA00960 

G0  TC  21 

VIA00970 

20 

TI-TC 

VIA00980 

21 

TF-T I*FDS 

VIA00990 

STF-TF 

VI  AO  1000 

UM-UR 

VIAOIOIO 

OTES-FOS 

VIA01020 

DTIN-FDI 

VIA01030 

TBl 11-TlM 

VIA01040 

TB12I-T2N 

V1A01050 

GO  TO  1 

VIA01060 

22 

WRITE(6,31ITHETA 

VIA01070 

31 

FORMAT  11 H, 'REAL  ANG.S 

2X 

»014.8) 

V1A01080 

IFlXFll 13I.EQ.0.00IG0 

TO 

25 

VIA01090 

0£V«C0Ntf*DM00f  (THETA-DATAN2IXF1I  lA),XFli  13II«’P1 1 ,t2.D0*Pl)  I 

VlAOIlOO 

S7 


FILE:  MAIN 


FOR  Than  pi 


THE  BROWN  BICENTENNIAL  COMPUTER  CENTER 


GO  TC  27 

VIAOUIO 

25 

IFUFIllA)  .GT.O.DOIGO  TO  2o 

VIA01120 

OEV-  CONV  «OMOU  I { THE  T A-t-1 . 500«P  I ) t < 2.  00«P  I)) 

VIA01I30 

GO  TO  27 

VI  AO  1140 

26 

0EV«C0NV*0M00(ITHETA4-.500«P1)  f 12  .OU«PI ) 1 

VIA01150 

27 

WR1TE(8,23)0EV 

VIA01160 

WRITE16.23I0EV 

V1A01170 

23 

FORMATllH  t'THE  DEVIATION  FROM  THE  MIND  OPPOSITE  IS 

• .2Xt014.a,2X, V1A01180 

C* DEGREES.' ) 

VIA01190 

30 

CONTINUE 

VIA0L200 

STOP 

VIA01210 

ENO 

VIA01220 

FILE:  CPLANT  FUKTRmN  PI 


THfc  liKUrtN  BICENTENNIAL  COMPUTtR  CENTER 


C 

C 

C 

c 

c 

c 

c 


SOBRCUTINE  PLANT  U iNtYTEL ) PLAOOOlO 

THE  PURPOSE  IS  mITH  GIVEN  INITIAL  PUS  IT  I ON. HEAD ING  AS  MELL  AS  WIN0PLA00020 
KNOVgN  UYNAMICS  AND  lONTROL  LAW, COMPUTE  THE  CORRESPONDING  STATE  S , ANPLA00030 


INTEGRATED  VECTOR  WHICH  IS  NEEUEU  IN  L SO  ESTIMATION. 
INPUT:IN1 TI AL  STATE  VECTOR  • XIN* 

0UTPUT:EINAL  STATE  VECTOR  AND  SOME  INTEGRATED  VECTOR  'YTEL* 


IMPLICIT  kEAL»8(  A-H.O-Z) 

DI  MENSION  XINII  t ,Y  I UI.OERYIIAI.  PRMT  ISt.AUXI  6,  lA  I , YTEL  ( 1) . Tb(  21  . 
CCW(2.2I.wIN(2) 

CCMMON/OUT/TP  , I HI , THE.ENR , ALP 
COMMON  OS. 01. ED.  T I .TF.NC . IN, IM 
COMMON/Fl/A.U.Tb.CW.WlN.OP 
EXTERNAL  FCTl.UUTPl 


C 

c 

C 


INITIALIZE  RtLATED  VECTORS  FOR  INTEGRATION  PURPOSE 


A 

C 

c 

c 


PRMTI 1>«T1 
PRMT (2)=TF 
PRMTI3) ^01 
PRMT IA)»EU 
TP«T  I 
ALP-TI 
N0IM>14 
00  I 1 = 1, U 
OERYII >=1.00/14.00 
00  2 1=1,2 
YI I)=X1NI1| 

THI=XIN(3) 

00  3 1=3,12 
Yin-O.OD 
DO  6 1=13,14 
Y1I)*W  INI  1-12) 
mRI TEIB.B) 

FORMAT  I IH  ,2X,'TIME* ,12X,' XI !)• ,12X,*  X12)' *12X,'X(3) • ,12X,'WlN0*, 

C12X, 'ANGL* , lOX, 'U* , 14X, 'BANK  ANG* ) 

WR1TE(6,7) 

FORMAT (1H0.2X, *T IME ', 12X, *X( !)• , 12X, 'XI 2) • ,12Xt*  XI3) • ,12X,' MIND* .1PLA00390 
C2X  , 'ANGL' ,10X ,'U* ,14X, 'ENERGY* ) PLA00400 

PLA00410 

START  INTEGRATION  PLA00420 

PLA00430 

CALL  ORK&S(PRNT,Y,DERYfNDlN,lHLF,FCTl,OUTPl,AUX)  PLA00440 


PLAD0040 
PLA00050 
PLA00060 
PLA00070 
PLA00080 
PLA00090 
PLAOOlOO 
PLAOOllO 
PLA00120 
PLA 00130 
PLA00140 
PLAOOISO 
PLA00160 
PLA00170 
PLA00180 
PLA00190 
PLA00200 
PLA00210 
PLA00220 
PLA00230 
PLA00240 
PLA00250 
PLA00260 
PLA00270 
PLA00280 
PLA00290 
PLA00300 
PLA00310 
PLA00320 
PLA00330 
PLA00340 
PLA00350 
PLA00360 
PLA00370 
PLA00380 


UR1TEI6,4)1HLF 
FOHMATIIHO,'  1HLF=*  ,121 

STORE  FINAL  STATE  ANO  INTEGRATED  VECTOR 

DO  b 1=1,  14 
VTELm«YIl) 

RETURN 

EMO 

SUBROUTINE  OUTPl IX, Y,OERY , 1HLF,N01H,PHMT ) 
IMPLICIT  REAL*81A-H,0-Z) 


38 


PLA004SO 
PLA00460 
PLA00470 
PLA00480 
PLA00490 
PLA00500 
PLAOOS 10 
PLA00520 
PLA00530 
PLA00S40 
PLA005S0 


t 


o ri  o o 


FlLEi  CPLANT  FORTRAN  PI 


THE  BRQMN  BICENTENNIAL  COMPUTER  CENTER 


2 

3 

4 


1 


2 


3 


4 

1 


DIMENSION  VdItPRMT  111  tOERYCll  »TB(2I  tCMI  2t2)  tWINI2)  tTEXi  3) 
COMMON  DStOltEO*  T I tTF*NCt INt IN 
CONMON/FI/AtUtTBtCMtNlNtUPtOCvTEXfPl  *Cy 
COMMON/ OUT / T P . T H 1 t T MET A t ENR t ALP 

IF  1 1 X. LT. AL P-. 500*01 1. OR. IX. GT. ALP*. 500*01 II  RETURN 
WNAG-0SQRTIVI13)**2*VI 141**2) 

1FIVI141.E0.0.001GO  TO  2 

IFIVI131.E0.0.D01CO  TO  3 

WANG-0ATAN21V(141«VI13II*CV 

GO  TO  4 

WANG*0.00 

GO  TO  4 

WANG-9.001 

GO  TO  4 

BK>0ATAN2IA*UPt32.0700)*CV 

WRI  TElBfllX.YIl)  .YI21tTHETAtUMAG»MANGtUP«BK 
ALP«ALP*OFLOATI  IM/10)*D1 

1FIIX.LT.TP-.500*011.0R.IX.GT.TP*.500*011)RETURN 


PLA00560 
PLA00570 
PLA00580 
PLA00590 
PLA00600 
PLA00610 
PLA00620 
PLA00630 
PLA00640 
PLA00650 
PLA00660 
PLA00670 
PLA00680 
PL AO 0690 
PLA00700 
PLA00710 
PLA00720 
PLA00730 


PLA00740 

PRINT  OUT  2 CONSECUTIVE  SETS  OF  TINEtSTATEStMlNOtCONTROL  ANO  ENERGY  PLA00750 


EST.  INTERVAL  PLA00760 

PLA00770 

WRITEl6tl  IX.Vm  »YI21.THETA»WNAGfMANGtUPtENR  PLA00780 

FORMATUH  *010.4»7I2X»014.8)1  PLA00790 

TP«TP*0FL0ATI1N  1*0  I PLA00800 

RETURN  PLA00810 

END  PLA00820 

SUBROUTINE  FCTl I Tt Y. OERY ) PLA00830 

IMPLICIT  REAL*8IA-H«0-Z1  PLA00840 


DIMENSION  Yll)»0ERYlll.TBI21  tCMl2t2)  tMINU) 
COMMON  OS(DItEOtTItTF»NCtlNt IN 
CONMON/Fl/A«UltTBtCM»WINtURE 
CONNON/OUT/ TP « T HI . THETA » E NR 
IF)1TBI2).LT.TBI1)).AN0.1T.GE.TBII1)1G0  TO  4 
1FIT.LT.TS1111G0  TO  2 
IFIT.LT.TBI211G0  TO  3 
URE-Ul 

U IN- ITBI 1 1-T I*T-TB1 21 1 *U1 
GO  TO  1 
U1N-1T-TI)*U1 
URE-Ul 
GO  TO  1 

U1N-ITBI11-T11*U1 

URE-O.OO 

GO  TO  1 

UIN-ITaill-TI)*Ul 

URE-Ul 

THETA-TH1*U1N 

OERY 1 1 1-A*0C0SI THE  TA 1*Y1 13) 

OERY 12 1 -A*0S I NIT HET A 1 *Y 1 14 1 

0ERYI31-0S1 NIUINI 

OERYI41-OCOS1U1N1 

OERY 19 1 -OERY I 1 1*0ERY 14 1 

OERY IB  1 -OERY 12 1 *OERY 14 1 

0SRYIT1-0ERY111*0ERYI31 


PLA00850 
PLA00860 
PLA00870 
PLA00B80 
PLA00890 
PL  A009  00 
PLA00910 
PLA00920 
PLA00930 
PLA00940 
PLA00950 
PLA00960 
PLA00970 
PLA00980 
PLA00990 
PLAOIOOO 
PLAOlOlO 
PLA01020 
PLA01030 
PLA01040 
PLA01090 
PLA01060 
PLA01070 
PLAOIOSO 
PLA01090 
PLAOllOO 


FILE:  CPLANT  FOKTRAN  PI 


THk  &RQWN  olCENTENNIAL  COMPUTER  CENTER 


OERY(8i>OeRV(2l«DERY(i) 

PLAOlllO 

s 

0ERY(9)-T*0ERY(i) 

PLA01120 

i 

0ERY(10)»T*0ERY(4I 

PL401130 

- 

0ERY(U|>Y(  11 

PLAU1140 

OLRYU2l>Y(2l 

PLAU1150 

' 

OEKY(li)>CMll ,l)*VI13t*CW(l«2l«Y (19) 

PLA01160 

• 

r 

UERY ( 19)-CW( 2. 1 ) *Y( 13) ♦: M( 2t  2) «Y ( 14) 

PLAJ1170 

“ 

ENR*U1*UIN 

PLA01180 

RETURN 

PLA01190 

r . 

END 

PLA01200 

1 


« 

f 

I 

I 

I 

I 

I 


I 


o o o o o o oOo 


file:  CESTM 


FuRTKAN  FI 


THE  dRUMN  BICE'4TCNNUL  :dMPuTER  CENTER 


SUBKOUTINE  ESTM( XI f XF lEXtEAtEtt) 

THE  PURPOSE  IS  TO  LUHPUTE  A LEAST  SQUARE  ESTIMATE  OF  PARACHUTE 
HEADING  AND  COEFFICIENTS  OF  WIND  COMPONENTS. 

INPUT:  initial  STATE'Xl'tFlNAL  STATE  ANU  INTEGRATED  VECTOR 
UUTPUT:  ESTIMATED  HEADING  'EX'.COEFF.  VECTORS  'EA'L'EB*. 


•XF* 


IMPLICIT  REAL*8( A-H.U-Z) 

DIMENSION  XII  U iXFI  1)  ,EA(1I  fEt)(U,P(2.2l»CI(2)  fSI(2)  tPCI  2 1 1 PS  1 2 1 . 
COi2t2l tM INI2).CR(2t2)i Td(2) t TEXI S) »DER Y2I 4) . Y2( 4) , PRMT2 (>) «AUX2I8 
Ct4)  .TEXCI3) 

COMMON  DTES.DTIN.ERdOf  T I tTF *NLt INt 1M» IPRI 
COMMCN/UUT/TPR.  THI  tTHE.ENR.ALP«RAMP 
C0MM0N/Fl/V.U.T8tCM*MlNtUPt0EG.TEXC»PltCV 
CUMMON/F2/TEX 
EXTERNAL  FCT2.0UTP2 

COMPUTE  THE  ESTIMATED  HEADING  'EX' 

PUt  ll>XFm-XI(  li 
P(l.21«TF*XFm-TI*XI(  l)-XF(ll) 

P(2tl)«XF(2)-XI(2) 

P(2.2»»TF*XFC2)-TI*XII2I-XFI  12i 
Cl  II  l>XF(<i) 

CI(2I*XF( 10) 

SII1)-XF(3) 

SI  I2)»XFI9I 
PCI  l)-XF(5) 

PCt2)-XF(6) 

PSI 1)>XF| 7) 

PS(2)«XF(8) 

UNRC-XFf6)-XFI7)-l PI 2t 1 l*XF 1 4)-P lit  1 )*XF( 3) I /DTES 
0MC-XFIS)^XF(8)-1PI l,l)*XF|4)*PI2,l)*XF(3))/DTES 
Sb>1.0D/DTES«*3 

01  If  II«4.00*SO*ITF**2FTF*TI4TI**2) 

01  If2)«-G.U0*»S0«»ITF4TI ) 

0l2fl)«0(l  »2) 

0l2f2)«12.00*S0 
1FIENR.lt .OEGIGO  TO  24 
RMO-O.OU 


ESTDDDIO 

EST00020 

EST0003D 

ESTDD040 

EST00D50 

EST00060 

ESTD007D 

EST0008U 

EST00090 

ESTODIOO 

ESTOOllO 

EST00120 

ESTD0130 

EST00140 

EST00150 

ESTOUIbO 

EST00170 

EST0018D 

EST00190 

EST00200 

EST0021D 

ESTOG220 

EST00230 

ESTD0240 

EST00250 

EST00260 

EST00270 

EST00280 

ESTUU290 

EST00300 

ESTDD310 

EST00320 

ESTD0330 

ESTU0340 

EST00350 

EST00360 

EST00370 

EST00380 

EST00390 

EST00400 


RMU*O.DO 
DO  6 l"lf2 
00  7 J•l,^ 

RMU-RMUOI  l»J)*tP(2fJ)*Cin)-PU.J)*Slim 
RMO-RMO^OI  lfJ)«(P(l.J)*Cl(ll4PI2«J)*SI(  ID 
7 CONTINUE 

6 CONTINUE 

UMER«PCI2)-PSm-RMU 
OENOMaPCt 1)4PSI2)-RM0 
MRlTEl6f27l  UMEkfOENOM 

27  FURMATllH  »*NUMERATOR«  • 1 014  .8f  2Xt  • OENJM  INATOK-  •.014.8) 

EX  ■0ATAN2IUMER.0ENUM) 

HRITEI6f27)UMRCf  CMC 
TEXC 1 1)  >DATAN2 1 UMRC  . OMC  ) 

C 


ESTDD410 
ESTD0420 
EST00430 
EST00440 
ESTJ0450 
ESTD0460 
ESTDD470 
EST0048D 
EST00490 
E STUDS 00 
EST00510 
EST00320 
E ST0U530 
EST00S4J 
ESTUUSSU 


42 


f-IL£:  CESTN  EUKTRAN  PI 


THE  bRUMN  blCENTENNUL  CUMPOTER  CENTER 


initialize  EST  . CUEPF 

i 00  2 1*1.2 
EAI I 1*0.00 
Eu(  I 1*0.00 

COMPUTE  estimated  VECTORS  'EA*  t *Eb' 

DO  3 1*1.2 
DO  4 J*1.2 

EAI  I)*EA(I)«0(1 .J)*(P1 1. J)-y*10CuS(bA)«Cl( 
EBI I)*EBI I 1^01 I.J l*IP(2. JI-V*(OSIN(EX)*L II 
CONTINUE 
CONTINUE 

COMPUTE  CONSTANT  EST.  VECTOR 

TEXCI2  )*(AFI1I-XI(  l»-V*UFC4)*DCUSITEXCIll 
COTES 

TEXC(3)*(XF|2)-XI I2)-V»(XF(4)*0S1N(TEXCI II 
COTES 

STURE  LINEAR  EST.  VECTCR  FUR  ERROR  COMPUTATION 

TEXI1I*EX 

TEX<2)*EAin 

TEX(3)*EAI2) 

TEX(4)*Eb(ll 
TEXI5I *Eb(2l 
OUN*O.UO 

COMPUTE  THE  ESTIMATION  ERROR 

N0IP2-4 
PRMT2(1I  -Tl 
PRMT2I2I-TF 
PRMT2I3I-OT1N 
PRMT2(4)-ERbO 

00  9 I«1.4 
DERY2II 1*1.00/4.00 
00  10  1-1.2 

} V2(  II-MINII) 

Y2I  31-0.00 
Y2I4I-0.00 

1 PR  1-0 

CALL  ORKOS(PRNT2.Y2tOERY2 .N0IM2 . IHlFZ ,FCT2 
WR1TEI6. IS) 1HLF2 
i FORMATIIH  .• 1HLF2-* .12) 

lF(Y21i).LE.1.0- lOIIPRl-1 
WRIT  EUf  S)NC 
WRI  TEUtSINC 

FORMAT! IHO. 'AFTER  THE* .14.'  TH  ESTIMATION. 
C ERROR  ARE*//1H  . SX. *X 1 3 ) • » 14X» • Al 1 ) *. 14X» 
C12) • *14X.*ERR0R* ) 

NHITEI6.8IEX.EAI II. EA( 2) .EBI lI.EBl  2I.Y2I3) 


E STOOS60 
EST00570 
EST00S80 
EST00S90 
EST00600 
ESTOOblO 
ESTOOt.20 
EST00630 
EST00640 
EST00650 

J)-0S1N(EX)«SIIJ)))  EST00660 

J)OCOS(EX)«SI(J)))  ESTOObTO 

EST00680 

EST00690 

EST00700 

EST00710 

EST00720 

l-XFI 3)40SIN( TEXCI 1) I ) I/E  ST00730 

EST00740 

l-XFl  3)«0SIN(  TEXCI  II 1 1 I/E  ST00750 

EST00760 

EST00770 

. EST00780 

EST00790 
EST00800 
EST00810 
EST00820 
EST00830 
EST00840 
ESTOObSJ 
ESTU0860 
EST00870 
EST00880 
E ST00890 
EST00900 
EST00910 
EST0U920 
EST 009 30 
EST00940 
EST009S0 
EST00960 
EST00970 
EST00980 
EST00990 
ESTOIOOO 

.0UTP2.AUX2)  ESTOlOlO 

ESTJ1020 

EST01030 

EST01040 

EST01050 

ESTOIOAO 

THE  ESTIMATED  STATE  AN0EST01070 

*A(2I •.14X»*tt(l)*.14X.«BEST0l080 

EST01090 

ESTOllOO 


.0UTP2.AUX2) 


flier***-*-''- 


FlLt:  CESTM 


FOR  THAN  PI 


THt  6K0MN  aitcNTENNIAL  COMPUTER  CENTER 


MRlTE(8>8)EX.EA(l).EA(2)»Ea(l>t  EBt2>iY2(3) 

8 FORMATUH  t6l014.  8»4X)  I 

URITEC8,8iTEXCmtTEXC(2)  »0UM,TEXC(i)t0UH,Y2(A) 

C 

C UPOATE  INITIAL  CONDITION 
C 

DO  16  1«1,2 
16  Xini-XFIl) 

Xli3t>THE 
00  28  l-ltZ 

28  WlNin«V2(  llAKAMP 

EX-EX«THE  -TMI 
TEXCm-TEXCllKTHE-THl 
RETURN 
ENO 

SUBROUTINE  FC*’< Tt Y2»0EKY2  I 
IMPLICIT  REAL  ..A-H. 0-2) 

DIMENSION  V2C1I  tMl NI2  I tOEKV2  (1 1.  Dm  U 1 2 I « T X(S  1 , T8(  2lt  TXC(  31 

COMMON  0St01tEO(Tl,TF,NC«IN«IM,lPK 

COMMON/ OUT/ TPR* T HI » T HE t ENR 

COMMON/Fl/AtUl tTb»DhtMlN»UPO,OGUtTXCtPItCV 

C0MM0N/F2/TX 

lF((T8l2I.LT.Tb(ll).AND.(T.GE.TB(ll)IG0  TO  3 
•FIT.LT.TB4 IIIGO  TO  2 
1F(T.LT.TB(2I1GU  TO  3 
UlN«fTBIl)-TI«-T-Ti)l2n*Jl 
60  TO  1 

2 U1N»(T-TI  )*U1 
GO  TO  1 

3 UIN-ITBI  ll-TIlnil 

1 THETA«THI>U1N 

AN6L«TX(1)aU1N 

ANGC«TXC11)*U1N 

0Vl«A*0C0SITHETA)*V2m 

UY2-A*OSINITHETA1aY2(2) 

0ERV2fn«0Mll»n*Y211)A0Bl  lt2)*V2I2l 
0ERY2(2l-0M(2»l)*V2fll«0H(2t2)«Y2(2l 
DERY213I-I0Y1>A*0C0SUNGL1>TX(2I-TX(3I«T1»»2»(DY2 
C-A* OS I N1 ANGLl -TX 16 1 -TX 1 5 I *T I *«2 
0ERV2(6l«(DYl>A«0C0S(ANGCI«TXCI2l)**26(UY2-A«0SlN(ANGCt>TXCt3) 
CJ*«2 
RETURN 
ENO 

SUBROUTINE  OUTP2IXtV2tOERV2t lHLF2tNDlM2* PRMT2I 

IMPLICIT  REAL*SIA>H,0-Zl 

DIMENSION  V241»tOERV2UltPRMT2m 

RETURN 

ENO 


ESTOlllO 

EST01120 

EST01130 

EST01160 

EST01150 

EST01160 

ESTOilTO 

EST01180 

EST01190 

EST01200 

E6T0L210 

EST0I220 

EST01230 

EST01260 

EST01250 

EST01260 

EST0127U 

EST01280 

EST01290 

EST01300 

EST01310 

EST01320 

EST01330 

EST01360 

EST01350 

EST01360 

EST01370 

EST013B0 

EST01390 

EST01600 

EST0161U 

EST01620 

EST01630 

EST01660 

EST01630 

ESTU1660 

EST01670 

EST01680 

EST01690 

ESTOISOO 

EST01510 

EST01520 

EST01S30 

EST01360 

ESTOISSO 

EST01660 

EST01S70 

ESTUlSbO 


O O >j  O ' ' o o o o u 


FILE:  PREO 


FORTRAN  PI 


THE  BROWN  BICENTENNIAL  COMPUTER  CENTER 


SUttROUTINE  PREOtXf£X»EAtEB»T»TlR»T2R,UR) 

THE  PURPOSE  IS  TO  CCMPUT E A BANC-BANC  CONTROL  WHICH  DRIVES  THE 
NUOEL  SYSTEM  TO  THE  TARGET  VIA  A GEOMETRICAL  APPROACH. 

INPUT:  state  vector  'X* f EST.HEAOINC  *EX* tCOEFF .• EA • & 

TIME. 

OUTPUT:  SWITCH  TlMEStCONTRUL 


PREOOOlO 
PKEU0020 
PREU0030 
•EB*. INITIAL  PKE00U40 
PKE00050 


implicit  REAL*8IA-H,0-£) 

OIMENSIUN  xm.EAmtEB(l}»21N(2).TBDI2)tCWD(2t2)fWN0( 
COMMON  OS«OItERBO»  TI t TF »NP» INf 1 M, 1 PRl 
COMMON/PR/WlNOtlMP 

CONMCN/Fl/V,UOLtTBO.CWDtWNOfUPOtUCL»TXCtPltCV 
COMMON/EX/TFlN.RRfl SK 
COMMON/LAST/VT.OLJ 

COORDINATE  TRANSFORMATION 

TEN0>1.00/0FL0AT( IN-NP) 

SCAL-TFIN-T 

WRlTEf8»l«)EAm«EA12)tEBI  l)f  EB12) 

14  FORMAT! IH  *4(014.8 *2X) I 
VT«V*SCAL 

ItNm«X(l}/VT^(EAn)»EA(2)*(TFlN*^T)/2.00l/V 
Z1N(2I-X(2I/VT«(EB(1)«Eb(2I*(TF1N^T)/2.00)/V 
WlN0<0ATAN2((EBm^EB(2)*TFlNlf  (EA(  1>^EA(2)*TFINII-P1 
RH0«0SQRT(ZlNm**2  4ZlN(2l**2) 

PHI-0ATAN2(Z1N(2) »Z1N( U t 
WRITElBtVlRHOiPHIi WIND 

9 FORMATUH  * BX,  • RHO*  *12X  t * PHI  • tl2X  . *N  I NO  ANGLE  •/ IH  , 2Xi 

TIS-O.OU 
T2S-0.0U 
lMP-0 
PSl-O.OO 
PS2-0.0U 
PSU-U.OO 
POLJ>I.U10 
PEFF-0.00 
OEFF-0.00 
0EFF«0.00 

IF ( RHO.GE.l. 00)  lMP-1 
C 

C COMPUTE  BANG-BANG  COKTRCL  ACCORDING  TO  LINEAR  WIND  MODEL 
C 

CALL  MCEUIRH0,PHltEXtTlS*T2StU) 

IFI  iMP.NE.nCO  TO  6 
OET-VT*OSORT(OLJ) 

IMP-0 

IF(TEN0.GE.T2$)0EFF-0ABS((TEND-T2S)«U) 

LPSI-TIS 

CPS2-T2S 

CPU-U 

IFIIPRI.EO.DGU  TO  11 
IFIISK.EO.DGO  TO  12 


45 


PREUOObO 
PRE0U07U 
PRE00U80 
PRE0009J 
2)tTXC(3l  PKEOUlUO 
PREOUllO 
PRE00120 
PRE 00130 
PRE00140 
PRE00150 
PRE00160 
PRE00170 
PRE00I80 
PRE00190 
PRE00200 
PRE 00210 
PRE00220 
PREJ0230 
PRE 00240 
PRE002S0 
PRE00260 
PRE00270 
PKE0U280 
PRE 002 90 
4(014. 8t2Xl)PRE00 300 
PRE00310 
PRE 00320 
PKE0J330 
PRE00340 
PRE00350 
PRE 00360 
PRE00370 
PRE00380 
PRE00390 
PKE 00400 
PRE00410 
PRE00420 
PKE00430 
PRE00440 
PRE00450 
PRE00460 
PRE00470 
PRE 004 80 
PRE00490 
PKEOOSOO 
PREOOSIO 
PRE00520 
PRE00S30 
PRE 00340 
PRE00330 


J 


f-ILEt  PREO 


FORTRAN  PI 


THE  BROWN  BICENTENNIAL  COMPUTER  CENTER 


C COMPUTE  BANC-BANG  CONTROL  ACCWOING  TO  CONSTANT  Hi  NO  NOOEL 
C 

ilN(l)«lX(  P«TXC(2|4iSCAU/VT 
ZIN(2)-|XI2)-i-TXC(3l*SCAL  l/VT 
WlNO«OATAN2 (TXC13 ) t TXC12 ) l-PI 
RHO- OSQRTUINI  1)**2«2 INI  21**2) 

PHl«DATAN2(ZIN(2)t21Nlll) 

WRITE! Bt9)RH0tPHI  ,HlNO 

lFIRHO.GE.l.OOlINP-1 

SP-TXCm 

CALL  MCEOlRHOtPHI tSPtTlS.T2SfU) 

IF! INP.NE.llCO  TO  6 
lNP-0 

POLO«VT*OSQRT!OLJl 

PSI-TIS 

PS2-T2S 

PSU-U 

C 

C COMPUTE  BANG-BANG  CONTROL  ACCORDING  TO  LINEAR  PLUS  CONSTANT 
C 
12 


PRE00560 
PRE00570 
PREOOSBO 
PRE00S90 
PRE00600 
PRE0D610 
PRE006  20 
PRE00630 
PRE00640 
PRE 00650 
PRE00660 
PRE00670 
PRE00680 
PRE00690 
PRE00700 
PRE00710 
PRE00720 
PRE00730 
WIND  M00ELPRE00740 
PRE00750 


13 

11 


10 


OSCA»SCAL*RK  PRE 00760 

RSCA-OSCA*T  PRE00770 

REM-SCAL-OSCA  PRE007B0 

ZIN(1)>(X(1)*(£A(1 )*EA(2 )*I0SCA*2.D0*T)/2.00)*DSCA*I  EA(  1)*EA(2)*  PRE 00790 
CRSCA1*REM)/VT  PRE00800 

ZlM2)«(X(2)*CEB(ll*EBt2)*(OSCA*2.O0*T)/2.U0)*DSCA*(Eai  1)*EBI2)*  PRE00810 

CRSCA)*REM1/VT  PRE00820 

H1ND-0ATAN21EB!  1)  *£B1  2I*RSCA  .EA(  1)  «-EA(  2) *RSCA)-PI  PRE00B30 

RHU«OS  ORT ( Z 1 N ( 1 ) **2  * Z IN ( 2 )**  2 1 PRE  00840 

PHI«0ATAN21ZIN(2) tXlNll ) ) PRE00850 

WRlTE(8i9)RH0»PHlf WIND  PRE00860 

1FIRHO.GE.1.00I1MP>1  PRE00870 

CALL  MCEOlRHOtPHI tEXtTIStT2StU)  PRE00880 

IF! IMP.NE.IIGO  TO  6 PRE00890 

0LJ*VT*DS0RT(0LJ1  PRE00900 

IF ITIS.GT. 0.001 OEFF-DAbS ( OMl N1 ( TlSt TEND )*U)  PRE00910 

IF1TEN0.GT.T2S)UEFF-0ABSI I TEN0-T2S)*U)  PRE00920 

HRITE(8t8)  PRE00930 

FORMATCIH  t BXt 'T 1* . 15X t • T2 • t 8Xi 'CUNTRUL* t 8Xt ' EXP  MISS  DISTANCE')  PRE00940 
WRlTEI8t7)CPSl tCPS2 tCPJtOETtPSltPS2tPSUtPOLJfTlStT2StUtOLJ  PREOU950 

FORMATllH  t2Xt41014.8f2X)/lH  t2X t4(Dl4 .8 t2X I/IH  t2Xt 4(014.8. 2X ) ) PRE00960 

IFICPSI.EO.O.OOIGO  TO  13  PRE00970 

IFITIS.EQ.O.DOIGO  TC  11  PRE00980 

OEFF-OA3SIDNIN1(CPS1.TENDI*CPU)  PRE00990 

IF((OEFF.CE.OEFF).ANO.(OEFF.GE.PEFFIIGO  TO  4 PREOIOOO 

IFKPEFF.GE.OEFFI.ANO.IPEFF.GE.OEFFIIGO  TO  10  PREOlOlO 

T1S«CPS1  PRE01Q20 

T2S-CPS2  PRE01030 

U«CPU  PRE01040 

CO  TO  4 PRE01050 

T1S«PS1  PRE  01060 

T2S-PS2  PAE01070 

U«P SU  PREO 1080 

60  TO  4 PRE01090 

PREOllOO 


vr  ^ N.  O'  et  r 


FILE:  PRED 


FORTRAN  PI 


Thk  bROMN  blCfcNTENNIAL  COMPUTER  CENTER 


COMPUTE  SWITCH  T IHEStCUNTROL  IN  INERTIAL  COOROINATE 

PREOlllU 

PRE01120 

T1R«TIS*SCAL*T 

PREU1130 

I2R*T2S«SCAL *T 

PRE0L140 

UR>U/SCAL 

PRE01150 

WRI TE(8t2l 

PRE01160 

WRITE|6f2l 

PRE0U70 

FORMATIIHO ••THE  SWITCH  TINES  ANO  CONTROL  ARE  •// IH 

• SXt 'Tl', ISXf 'TPRE01180 

C2*« ISXt 'U'/l 

PRE01190 

NRITEiatnTIRfT2R*UR 

PRE01200 

WRI TEl6tllTlRfT2R»UR 

PRE01210 

FORMAT!  IH  .ilOU.8.2Xl) 

PRE31220 

GO  TO  A 

PRE01230 

WRITE! bf5) 

PRE01240 

FORMAT  !1H0, 'THE  FIRST  GEOMETRICAL  APPROACH  FAILS') 

PRE01250 

GO  TO  6 

PRE01260 

i return 

PRE01270 

end 

PREU128U 

FlLEt 

N6E0  EOMTRAN  PI  THE  BROmN  BICENTENNIAL  COMPUTER  CENTER 

SUBROUTINE  NGEOCRHO,PHI,THET AtUStTZStUSTAR) 

MCE 000 10 

C 

THIS  ROUTINE  COMPUTES  A BANG-OFF-BANG  CONTROL  VIA  A GEOMETRICAL 

MGE 00020 

c 

APPROACH.  THIS  IS  POSSIBLE  ONLY  WHEN  THE  PARACHUTE  IS  WITHIN  THE 

MGEOOOIO 

c 

UNIT  CIRCLE.  FOR  THE  CASE  WHEN  IT  FALLS  OUTSIDE  THE  UNIT 

CIRCLE. 

MGE00040 

c 

A SECOND  APPROACH  IS  USED  TO  COMPUTE  A BANG-OFF.  OFF-BANG 

>.  BANG* 

MGE00050 

c 

OR  OFF  CONTROL  DEPENDING  UN  WHICH  hOULO  RESULT  A MINIMAL 

EXPECTED 

MGE 00060 

c 

MISS  DISTANCE. 

MGE00070 

IMPLICIT  REAL  * B lA-H.O-ZI 

MCEOOOeO 

DIMENSION  RI2I.EI2I  tGU)tF(2l»TSTAR(2I.TSTARK(2t20I.TlC2i 

20I.T2I2 

.MGE00090 

C201«U(2I.UMI2I.0IST(2I 

MCEOOIOO 

COMNCN/LAST/VT.OLJ 

MGE  001 10 

COMMON/PR/SBETAtlMP 

MGE00120 

TW0PI»2.00*DARC0S(-ia>0l 

MCEOOllO 

MRITEI8.3I 

MGE00140 

Nl«5 

MGE00150 

c 

MGE00160 

C INlTlAtlZE  BEST  CONTROL *ENEHGV »BANG>OFF  TINES. 

MGE 00170 

C 

MGEOOIBO 

USTAR-0.00 

MGE 001 90 

BETA-SBETA 

MGE 00200 

ESTAR*1.010 

MGE00210 

TlS-0.00 

MGE00220 

1 

T2S«0.00 

NGE00230 

. 

10- 0 

MGE00260 

1 

IF(  IMP.EQ.DGO  TO  119 

MGE 00290 

1 

00  19  NN*1»N1 

MGE00260 

N>NN-(l«Nl)/2 

MGE00270 

1 

FN-OFLOAT(N) 

MGE 00280 

r 

P SI N»T WOP 1 «F N- THE TA^BE T A 

MGE 00290 

If 4PSIN. £0.0.001  CO  TO  19 

MGE 001 00 

1 

lF(DSIN(THETAI-PSlN*RHO«OCCS(PHn.NE.O.OO)  GO  TO  7 

MGEOOllO 

i 

1FI1.00-0C0S(1HETA)-PSIN*RH0*0SIN(PHII.NE. 0.001  GO  TO  7 

MGE00120 

1 

1FC1ABSINI.CE.2I  GO  TO  19 

MGEOOllO 

Rl 1I«1.00/PS1N 

MGE 00 140 

1 

Ulll-PSIN 

MGE 00150 

Em-PS1N**2 

MGEOOIBO 

C 

MGE00170 

C UBOATE  BEST  CONTROL t ENERGY. 

MGEOOIBO 

C 

MGE 00190 

IPIfSTAR.LT.EUIlGO  TO  19 

MGE00400 

IPIESTAR.EQ.EIinGO  TO  101 

MGE00410 

ESTARaKIll 

MGE 00420 

USTAR«UI 11 

MGE00410 

10*1 

MGE00440 

GO  TO  99 

MGE00450 

101 

IFIOABSCUUll.GE JMBSIUSTARIIGO  TO  19 

MGE00440 

USTAR-Um 

MGE00470  t 

10«1 

MGE004B0 

to 

URITEfB»9BI 

MCE00490 

fB 

FORNATIIH  »«T1«T2*  »//lH  tSR.'N* « TX»  *PS1NS17X.  *R( !)•  .lOX. 

•U(>IS  I0NCE00500 

1X.*EU»*I 

NGE00510 

MR1TEIB(29I  N.PSIN* RID* UllltEI  1» 

MGE00S20  i 

IS 

FORNATIIH  tSXtl2*SXf«(01«.B«9XI) 

MGE00530 

GO  TO  19 

MGE00540 

C 

MGE00950 

AB 

1 

J 

o Cl  o rt  o 


FILE:  NGEO 


FOR  TRAN  P 1 


THE  BROmN  bicentennial  COMPUTER  CENTER 


COMPUTE  THE  TURN  RACIUS 

T A-PS1N**2>2.00*I1.00-OCUSITHETA-BETAI) 

B- P SI N*  RHO* ( OS  I N ( PH I-T HET  A I -OS  INI PH I-BET  A1 ) 

C«  L.OO-RHO«»2 
0»d**2-A*C 

IF(O.LT.O.OO)  GO  TO  19 
RIII-lB»CSQRTIO))/A 
RI2  J-IB-OSCRTIon/A 
IF(O.NE.O.DO)  GO  TO  15 
J»1 

GO  TO  8 

15  Jl-0 
J2«0 

1F(RC1)«PS1N.LE.0.00)  GO  TC  5 
1F(RI1I*PS1N.GE. 1.001  GO  TO  5 
Jl-1 

5 1F(R(2)*PS1N.LE.0.00)  GO  TO  6 
1FIH(21«PSIN.GE. 1.001  GO  TO  6 
J2>1 

6 J-JUJ2 

1F1J.EQ.0>  GO  TO  19 
1FIJ.EU.2I  GO  TO  8 
IFlJl.EQ.l)  GO  TO  8 
llll)-RI2l 

COMPUTE  THE  CONTROL.  ENERGY.  ANO  TURN  ANGLE 

8 DO  9 1«1.J 
UII)«1.00/R1II 
El  Il-PSIR/Rin 

Fin«IRIll*IOSINITHETA|-OSlNIB£TA))-RHO*OCOSIPHl)l/ll.OO-Rll 

C) 

CII1«IR1  l)«IOCOSlBETAI-OCUS|THETAIl-RHO«OSlNlPHm/l  1.00-RI  I 
Cl 

tFlFtll.EO.-l.OOl  GO  TO  10 

YSTARI 1 1 -OS  1 6NI 1 .00  .Gl  1 1 l•OAI)COS  IF  1 1 1 1 

SO  TO  11 

10  TSTARIll-OARCCSIFIll) 

11  R1>1ABSINI»1 

COMPUTE  THE  SWITCH  TIMES 

00  12  KK-l.Kl 
IFIRIlll  16.16.18 

16  K-KK-lAN 
CO  TO  20 

18  R-KR-1 

20  TSTARKII .KI-TSTARI1IATW0PI6FL0ATIK1 
T1 1 1 *K l-R 1 1 |*|TSTARKI I .K l-THCTAI 
T2I l.KI-l.OO-RlI I•1TH0F16FN-TSTARKII•RI♦•ETA• 
IFITlll.Kl.LT.O.OOl  60  TO  12 
lFlT2li.RI.6T. 1.001  SO  TO  12 

17  HRITEI8.6I  N.FSlN.Rtll.Tlll.KI.T2II.RltTSTARR| I.KI.UI lltElll 


MCE  00560 
MGE00970 
MGE00S80 
MGE00590 
MGE00600 
MGE 00610 
MGE00620 
MGE00630 
MGE 00660 
NCE0065U 
NGE00660 
MGE 00670 
MGE00680 
MGE 006 90 
MGE 00700 
NGE00710 
MGE00720 
NGE00730 
MGE00760 
MGE 00750 
MCE00760 
MGE00770 
MGE 00780 
NGE00790 
NGE00800 
MCE 008 10 
M6E00820 
NCE00830 
MCE 00840 
N6E00850 
MCE 00860 
16FSINN6E00870 
NGE00880 
)*FS1NNGE00890 
N6E 00900 
NCE00910 
MGE 00920 
NGE00930 
MGE 00960 
N6E00950 
NGE00960 
MGE 00970 
MGE 00980 
N6E 00990 
NGEOIOOO 
NGEO 10 10 
NGEO 1020 
NGE01030 
NGE01060 
NGEO 1090 
NGE01060 
NGE01070 
NGEOIOOO 
NGEOIOOO 
NGEOllOO 


I 


FILE: 

NGEC  FORTRAN  PI  THE  OKOMN  BICENTENNIAL  COMPUTER  CENTER 

> C UPDATE  EEST  CONTROL»ENER6V»TlNfcS. 

MGEOlllO 

C 

IFIESTAR.LT.EUIIGO  to  12 

MCE01120 

NCE01130 

IFIESTAR.LQ.EIIIIGO  TO  100 

MGE01140 

ESTAR-Elll 

NGE01150 

USTAR-Ulll 

MGE01160 

T1S*T1(1»KI 

NGE01170 

T2S«  12  11  tKl 

MGEOllBO 

10-2 

MGE01190 

CO  TO  12 

M6E01200 

100 

IFlDABSiUtin.GE.OABSlUSTARI  IGO  TO  12 

MGE01210 

USTAR-Ul 1) 

MGE01220 

T1S*T1(1,K1 

MCE  012 30 

T2S-T211 tK) 

MCE01240 

11^2 

NGE01250 

12 

CONTINUE 

HGE 01260 

9 

CONTINUE  L 

NGE01270 

19 

continue 

MGE01280 

IF( lO.EO.OIGO  TO  108 

NGE 01290 

IFI  lO.NE.DGO  TO  101 

MCE 01 300 

C 

MGE01310 

C PRINT  OUT  THE  OEST  C0NTR0L*ENERGY*T1MES • 

NGE01320 

C 

MRlTE<8tl06l 

MGE01330 
NGE 01 340 

106 

F0RMATllH0t20Xt*BEST  CONTROL  * «3X  t'Hl  N ENERGYS/I 

NGE01350 

NRlTElBtlOSlUSTAR.ESTAR 

NGE01360 

105 

FORMAT ilH  »5X»*T1-T2*»10X*2(014.BII 

NGE 01 3 TO 

CO  TO  102 

NGE01380 

101 

NRlTElBtlOTl 

NGE01390 

107 

F0RMATllH0t8X**Tl*  .15X  t*T2*  »BX*  * BEST  CONTROL  *t  5Xt  *N1N  iNERGVn 

NGE01400 

MRITEI 8t 104) TlSt  T2StUSTAR »ESTAR 

NGE01410 

104 

FORMATIIH  (2X»41014.Bt2X)) 

NGE01420 

GO  TO  102 

NGE01430 

100 

lMP-1 

NGE01440 

C 

NGE 01450 

C THE 

FIRST  GEOMETRICAL  APPROACH  FAILS  IP  10-0. 

NGE01460 

C 

MRlTEIBtl09) 

NGE01470 
NGE 01480 

109 

PORMATllHOt*NO  FEASIBLE  BANG-OFF-BANG  CONTROL  EXISTS.*) 

NGE01490 

1 c 

NGE01500 

C START  THE  SECOND  GEOMETRIC#  APPROACH 

NGE01510 

NGE 01 520 

1 

X1-RH0»0C0S1PM1) 

NGE01530 

i 

X2-RHOPOS1N1PH1) 

NGE01540 

OLJ- 1.020 

NGE01550 

1 

OSMl-0.00 

NGE 01 560 

, 

0SM2-0.00 

NGE01970  < 

00  115  N-lf5 

NGE015B0 

BETA«SBETAaTMCP1*OFLOAT1N-3) 

NGE01590  , 

IFITHETA.EQ.BETAIGO  TO  115 

NGE01600  ' 

1 c 

NGE01610 

C COMPUTE  SINGLE  SHlTCH  TIME  AMO  CCNTROL 

NGE01620 

C 

OCX-CCOSITHETA) 

NGE01630 

NGE01640 

OSA-OSINI THETA) 

NGE016S0 

SO 

1 

f 

• *.  : • X'  « ■■‘Vf  ■ 

o r>  o 


FILE*  MGEC 


FORTRAN  PI 


THE  ttRUMN  BICENTENNIAL  COMPUTER  CENTER 


0CB*0C03(BETAI 

OSB-OSIN(dETA) 

SBa>OSB-OSX 

CBX>OCtt-OCX 

OIF-THETA-BETA 


MGE01660 

NGE01670 

NGE01680 

MGE0169U 

MGE01700 


OENCM«U  .0U-(0SIN(01FI  )/0IF)»*^«A.00«110SIN(0iF/2.0U)  )**4)/0IF*«2  MGE01710 
01ST11)>|  (X2*DCB*X1*0SB«(X1*CBX*X2«3BX4-1.00-0C0S(0IF)|/U1F)«*2)/DEMGE01720 
CNOM  MGE01730 

01  STI2I-I  (Xl*DSX-X2*0CX-(Xl*CBX*X2*SBX-1.00*0C0SIDIFn/UIF»O*2»/UEM0E0l740 
CNOM  NGE0I730 

UH(1)*1.0U*X1*0CB^X2*0SB«<X1«SBX-X2«C6X-US1N(01F)I/0IF  MGE 01760 

UM12)«-Xl*0CX-X2*0SX-(Xl*SBX-X2*CbX^DSIN(0IF  »-(2 .00-2.00*DCOS ( 0 IF )MGE017  70 
Cl/0IF)/0IF  MGE017B0 

00  111  K«lf2  MGE01790 

IFIIUMIK). GT .0.00) .AND. lUNlKl.LE.OENOMJ )G0  TO  117  MGE01800 

MGE  018  10 

MINIMAL  MISS  DISTANCE  OCCURS  AT  BOUNDARY  POINT  MGE01820 

MGE01830 

1F(( .NOT.ItUMIK) .LE.O.OOl.OH.lK.EQ.l))) .OR.t lUMIK) .LE.0.00).AND.(KMGE018A0 


c.Ea.iinco  TO  iib 

SWT1«1.00 

SMT2>0.00 

UPJ*IX1-S6X/D1F)**2^(X2^CBX/DIFI**2 
UB—OIF 
G0  TO  Hi 
118  SMT1«0.D0 

SMT2-1.00 

UPJ«IX1«^0CB)**2«(X2*0SB)**2 
UB-0.00 
GO  TC  113 
C 

C MINIMAL  MISS  DISTANCE  OCCURS  AT  SWITCH  TIME 
C 

117 


UPJ*01ST(K) 

IFIK.EQ.DGO 


TO  116 


C OFF'BANG  CONTROL  AND  SWITCH  TIME  ARE  COMPUTED 
C 

SWTl-O.DO 

SWT2-UMI2)/0£N0M 

UB*-DIF/I1.00>SWT2) 

G0  TO  113 
C 

C BANG-OFF  CONTROL  AND  SWITCH  TIME  ARE  COMPUTED 
C 

116 


SWT1«UMI1)/0EN0N 
SWT2-1.00 
UB«-01F/SWT1 

113  ROIST-VT*OSQRT(UPJ) 
IFUiPJ.GE.OLJIGO  TO 
OLJ-UPJ 
OSWl-SWTl 
0SW2-SWT2 
OU-UB 

ill  CONTINUE 


111 


51 


MGE01850 
MGE 01 860 
MGE01870 
MGE01880 
MGE01890 
MGE01900 
MGEU1910 
MGE  01 920 
MGE01930 
MGE 01 940 
MGE 01 950 
MGE01960 
MGE01970 
MGED1980 
MGE01990 
MGE02000 
MGE 020 10 
MGE02020 
MGE02030 
MGE02040 
MGE 020 50 
MGE02060 
MGE 020 70 
MGE02080 
MGE 02 090 
MGE02100 
MGE02110 
MGE  02  120 
MGE02130 
MGE02140 
MGE  02 150 
MGE02160 
MGE02170 
MGE 021 BO 
MGE02190 
MGE 022 00 


FlLEi  NGEO 


FORTRAN  PI 


THE  SROMN  BICENTENNIAL  COMPUTER  CENTER 


i 


115  CONTINUE 
TlS-OSMl 
T2S-0SH2 
USTAR«OU 

3 F0RMAT(lH0i6X»*N't9Xt*PSl  N* tllX t* R*  »13Xt  ' T1 • tl2X t • T2* t6X • 
CSTAR  K*t7X»*US13X.*E*»/l 
A FORMATIIH  « SX *12 tl X t7( 014 .8« 1X1 1 
102  RETURN 
END 


NGE02210 
NGE02220 
NGE02230 
NGE02240 
•THETA  MGE02250 
NGE 02260 
N6E02270 
NGE02280 
MGE02290 


I 

! 


! 

5 

I 


I 

j 


